r 



14* tf 



UK Patent Application „„GB ,,,,2 271 902 „ 3 ,A 



(43) Date of A Publication 27.04.1994 



(21) 


Application No 9321646L3 


(51) 


INT CL 5 






Q01S 1/02 1/045/14 


(22) 


Date of Filing 20.10.1993 










1 JIC n fF rift inn M 1 


(30) 


Priority Data 




um nMYY nPRT* rwii n7**A noic ncc/i ncAi n&cc 

Mil L/IVl^A UTDv U«M UiO 1 * wODU UOO 1 UOOO 




(31) UAfOSO// (32/ Z0.lU.l99Z \S6) Uo 




DR15 Dfi17 nA5fi Dft9A 






(56) 


Documents Cited 


(71) 


Appltaantfs) 




US 4912475 A US 4894662 A 




CatarpMarlnc 










(58) 


Field of Search 




(Incorporated fa) USA - Delaware) 




UK CL (Edition L ) H4D DMXX OPTO DSE DSPB DSPL 








INT CL 5 Q01S 1/02 1/04 5/12 5/14 




100 NuHftea&t Adam Street Peoria. Illinois 61629, 








United States of America 










(74) 


Agent and/or Address for Service 


(72) 


Inventory) 




Gfll Jennings & Every 




ChristosTKyrtsos 




Broedgate House, 7 Boon Street LONDON, 






EG2M 7LH, United Kingdom 



(54) Satellite navigation 



(57) The position of a satellite 102 in a satellite 
based navigation system 200 is determined without 
reliance on satellite ephemeris data. Orbital 
parameters are computed for each satellite 102. The 
orbital parameters can then be used to predict the 
position of each satellite 102 at any time. 
Subsequent ephemeris data may be compared to a 
predicted satellite position to determine whether the 
ephemeris data is corrupt The orbital parameters 
may be determined by: computing 8 pseudorange 
and a velocity for a selected satellite 102 for a 
plurality of times, computing at least three estimated 
positions of the satellite 102 from the pseudoranges 
and velocities, and computing orbital parameters for 
the satellite from the three estimated positions. In 
another embodiment the orbital parameters are 
determined by: determining the position of a 
receiver 212 for at least three times using a 
constellation of satellites 102, using the three 
receiver positions to triangulate on an average 
position for the selected satellite 102 in the 
constellation, repeating these steps until at least 
three mean satellite positions have been computed, 
computing the orbital parameters from the three 
mean positions of the selected satellite 102. 
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Method and Apparatus for Predicting the Position of 
a Satellite in a Satellite based Navigation System 



This invention relates generally to the field of navigation systems which 
use a constellation of Earth-orbiting satellites to determine the position of a 
receiver at or near the Earth's surface. More specifically, the invention relates 
to a method and apparatus for predicting the position of each satellite in the 
constellation. 



Several national governments, including the United States (U.S.) of 
America, are presently developing a terrestrial position determination system, 
referred to generically as a global positioning system (GPS). A GPS is a 
satellite-based radio-navigation system which is intended to provide highly 
accurate three-dimensional position information to receivers at or near the 
surface of the Earth. 

The U.S. government has designated its GPS the "NAVSTAR." The 
NAVSTAR GPS is expected to be declared fully operational by the U.S. 
government in 1993. The government of the former Union of Soviet Socialist 
Republics (U.S.S.R.) is engaged in the development of a GPS known as 
"GLONASS". Further, two European systems known as "NAVSAT" and 
"GRANAS" are also under development For ease of discussion, the 
following disclosure focuses specifically on the NAVSTAR GPS. The 
invention, however, has equal applicability to other global positioning systems. 

In the NAVSTAR GPS, it is envisioned that four orbiting GPS 
satellites will exist in each of six separate circular orbits to yield a total of 
twenty-four GPS satellites. Of these, twenty-one will be operational and three 
will serve as spares. The satellite orbits will be neither polar nor equatorial 
but will He in mutually orthogonal inclined planes. 

\ 



Each GPS satellite will orbit the Earth approximately once every 12 
hours. This coupled with the fact that the Earth rotates on its axis once every 
twenty-four hours causes each satellite to complete exactly two orbits while the 
Earth turns one revolution. 

The position of each satellite at any given time will be precisely known 
and will be continuously transmitted to the Earth. This position information, 
which indicates the position of the satellite in space with respect to time (GPS 
time), is known as ephemeris data. 

In addition to the ephemeris data, the navigation signal transmitted by 
each satellite includes a precise time at which the signal was transmitted. The 
distance or range from a receiver to each satellite may be determined from this 
time of transmission which is included in each navigation signal. By noting 
the time at which the signal was received at the receiver, a propagation time 
delay can be calculated. This time delay when multiplied by the speed of 
propagation of the signal will yield a "pseudorange" from the transmitting 
satellite to the receiver. 

The range is called a "pseudoxangt" because the receiver clock may 
not be precisely synchronized to GPS time and because propagation through 
the atmosphere introduces delays into the navigation signal propagation times. 
These result, respectively, in a clock bias (error) and an atmospheric bias 
(error). Clock biases may be as large as several milliseconds. 

Using these two pieces of information (the ephemeris data and the 
pseudorange) from at least three satellites, the position of a receiver with 
reject to the center of the Earth can be determined using passive triangulation 
techniques. 

Triangulation involves three steps. First, the position of at least three 
satellites in "view" of the receiver must be determined. Second, the distance 
from the receiver to each satellite must be determined. Finally, the 
information from the first two steps is used to geometrically determine the 
position of the receiver with respect to the center of the Earth. 



Trianguiation, using at least three of the orbiting GPS satellites, allows 
the absolute terrestrial position (longitude, latitude, and altitude with respect 
to the Earth's center) of any Earth receiver to be computed via simple 
geometric theory. The accuracy of the position estimate depends in part on 
the number of orbiting GPS satellites that are sampled. Using more GPS 
satellites in the computation can increase the accuracy of the terrestrial 
position estimate. 

Conventionally, four GPS satellites are sampled to determine each 
terrestrial position estimate. Three of the satellites are used for trianguiation, 
and a fourth is added to correct for the clock bias described above. If the 
receiver's clock were precisely synchronized with that of the GPS satellites, 
then this fourth satellite would not be necessary. However, precise (e.g,, 
atomic) clocks are expensive and are, therefore, not suitable for all 
applications. 

For a more detailed discussion on the NAVSTAR GPS, see Parkinson, 
Bradford W. and Gilbert, Stephen W., "NAVSTAR: Global Positioning 
System Ten Years Later," Proceedings of the IEEE, Vol. 71, No. 10, 
October 1983; and GPS: A Guide to the Next Utility, published by Trimble 
Navigation Ltd., Sunnyvale, California, 1989, pp. 1-47, both of which are 
incorporated herein by reference. For a detailed discussion of a vehicle 
positioning/navigation system which uses the NAVSTAR GPS, see commonly 
owned U.S. Pat. Appl. Ser. No. 07/628,560, entided "Vehicle Position 
Determination System and Method," filed December 3, 1990, which is 
incorporated herein by reference. 

In the NAVSTAR GPS, the electromagnetic signals from each satellite 
are continuously transmitted using a single carrier frequency. Each satellite, 
however, uses a different modulation gold code to allow differentiation of the 
signals. The carrier frequency is modulated using a pseudorandom signal 
which is unique to each GPS satellite. Consequently, the orbiting GPS 
satellites can be identified when the navigation signals are demodulated. 



Furthermore, the NAVSTAR GPS envisions two modes of modulation 
for the carrier wave using pseudorandom signals. In the first mode, the 
carrier is modulated by a "C/A signal" and is referred to as the 
"Coarse/ Acquisition mode". The Coarse/ Acquisition or C/A mode is also 
known as the "Standard Positioning Service". The C/A signal is a gold code 
sequence having a chip rate of 1.023 MHz. Gold code sequences are known 
in the art. 

A chip is one individual pulse of the pseudorandom code. The chip 
rate of a pseudorandom code sequence is the rate at which the chips in the 
sequence are generated. Consequently, the chip rate is equal to the code 
repetition rate divided by the number of members in the code. With respect 
to the C/A mode of the NAVSTAR GPS, there exists 1,023 chips in each gold 
code sequence and the sequence is repeated once every millisecond. Use of 
the 1.023 MHz gold code sequence from four orbiting GPS satellites enables 
the terrestrial position of an Earth receiver to be determined to an approximate 
accuracy of within 60 to 100 meters (with 95% confidence). 

The second mode of modulation in the NAVSTAR GPS is commonly 
referred to as the "precise" or "protected" (P) mode. In the P-mode, the 
pseudorandom code has a chip rate of 10.23 MHz. Moreover, the P-mode 
sequences are extremely long, so that the sequences repeat no more than once 
every 267 days. As a result, the terrestrial position of any Earth receiver can 
be determined to within an approximate accuracy of 16 meters (spherical error 
probable). The P-mode is also known as the "Precise Positioning Service". 

The P-mode sequences are held in secrecy by the United States 
government and are not made publicly available. The P-mode is intended for 
use only by Earth receivers specifically authorized by the United States 
government. 

Thus, given that the P-mode modulated data is generally not available, 
many GPS users must rely solely on the GPS data provided via the C/A mode 
of modulation. The U.S. government (the operator of the NAVSTAR GPS) 
may at certain times introduce errors into the C/A mode GPS data being 



transmitted from the GPS satellites by changing clock and/or ephemeris 
parameters* That is, the U.S. government can selectively corrupt the GPS 
data. This is known as "selective availability" or simply SA. SA may be 
activated for a variety of reasons, such as national security. 

When SA is activated, the U.S. government is still able to use the 
NAVSTAR GPS because the U.S. government has access to the P-mode 
modulation codes. The C/A mode data, however, may be rendered 
substantially less accurate. When this occurs, it is important for a navigation 
system which relies on the C/A mode of GPS to be capable of recognizing the 
corrupt data. 

Further, the U.S. government may use varying degrees of selective 
availability. The ephemeris and/or the clock parameters for one or more 
satellites may be slightly or substantially modified. 

In addition to selective availability, any one of the GPS satellites may 
malfunction and transmit erroneous data. Other errors may be induced into 
the GPS signals from atmospheric effects, receiver noise, reflections, shading, 
satellite path shifting, etcetera. The incorrect data resulting therefrom may 
result in computation of incorrect pseudoranges and incorrect satellite positions 
by a receiver. 

In such circumstances, it is desirable to recognize the bad satellite data 
and, if possible, compensate for it to prevent erroneous position estimates. 

GPS receiver systems may be either open-ended or differential (as 
discussed below). A differential GPS system will substantially reduce the 
effects of many of the errors discussed above. However, to reduce the effects 
of these errors further and for non-differential GPS systems, it is desirable to 
recognize the bad satellite data and, if possible, compensate for it to prevent 
erroneous position estimates. 



The invention is an apparatus and method for use with a satellite based 
navigation system. The invention allows the position of a satellite to be 
determined without reliance on the satellite ephemeris data. Alternatively, the 
invention may be used to continuously monitor the integrity of the ephemeris 
data received from a satellite. 

Orbital parameters are computed for each satellite. The orbital 
parameters can then be used to predict the position of each satellite at any 
time. In a first embodiment, the orbital parameters may be determined by: 
computing a pseudorange and a velocity for a selected satellite for a plurality 
of times, using the pseudoranges and velocities to compute at least three 
estimated positions of the satellite, and using the three estimated positions to 
compute orbital parameters for the satellite. 

In another embodiment, the orbital parameters are determined by: 
using a constellation of satellites to determine the position of a receiver for at 
least three times, using the three receiver positions to triangulate on an 
average position for the selected satellite in the constellation, repeating these 
steps until at least three mean satellite positions have been computed, 
computing the orbital parameters from the three mean positions of the selected 
satellite. 

In the drawings : - 

HG. 1 is a diagram depicting the NAVSTAR GPS satellites in their 
respective orbits around the Earth; 

FIG. 2 is a diagram illustrating an autonomous vehicle system which 
includes a constellation of four GPS satellites, a pseudolite, a base station, and 
an autonomous vehicle; 

FIG. 3 is a block diagram of the autonomous vehicle system detailing 
the vehicle positioning system of the autonomous vehicle; 

FIG. 4 is a block diagram of a GPS processing system; 



FIG. 5 is a diagram showing the geometric relationship between the 
center of the Earth, a vehicle near the surface of the Earth and a constellation 
of GPS satellites; 

FIG. 6 is a flow chart illustrating the steps of computing a best position 
estimate for a vehicle; 

FIG. 7 is a flow chart illustrating the method of the invention; 

FIG. 8 is a flow chart illustrating the steps of a first embodiment of the 
invention for predicting the orbital parameters of a satellite; 

FIG. 9 is a flow chart illustrating the steps of the invention for 
monitoring the integrity of GPS ephemeris data and for refining the predicted" 
orbital parameters for a satellite; and 

FIG. 10 is a flow chart illustrating the steps of a second embodiment 
of the invention for predicting the orbital parameters of a satellite; 



The present invention is now described with reference to the figures 
where like reference numbers denote like elements/steps. 

The invention is a method and apparatus for monitoring the integrity 
of position data received from a satellite based navigation system. In the 
preferred embodiment, the NAVSTAR Global Positioning System (GPS) is . 
used. As discussed above and illustrated in Figure 1, the NAVSTAR GPS 
includes twenty-one operational satellites 102 which orbit the Earth in six 
orbits 104. 

The invention is described in the environment of an autonomous vehicle 
system 200 as shown in Figure 2. A representative GPS constellation 202 
includes four GPS satellites 102(a)-102(d) for transmitting GPS data. A 
vehicle (e.g., an autonomous mining truck) 210 and a base station 220 are 
adapted to receive the GPS data/navigation signals from each GPS satellite 102 
in the constellation using respective GPS antennas 212 and 222. 

A GPS receiver can receive GPS navigation signals from a satellite 
which is "in view" of the receiver (i.e., line of sight communications). For 



example, "in view" may be defined as any satellite that is at least ten degrees 
up from the horizon. The ten degree angle provides a buffer zone between a 
useful, in view satellite and a satellite which is just passing out of view below 
the horizon. 

A "constellation** is a group of satellites selected from the satellites "in 
view" of a GPS receiver* For example, four satellites may be selected from 
a group of six which are in view of a GPS receiver. The four satellites are 
normally selected because of a favorable geometry for triangulation (discussed 
below). 

Base station 220 includes a GPS receiver which is located at a known, 
fixed position. Base station 220 communicates with vehicle 210 over 
communications channel 225. 

Communication channel 225 represents the communications link 
between base station 220 and vehicle 210. In the preferred embodiment, 
communication channel 225 comprises radio transceivers. Communication 
channel 225 is used to transfer data between base station 220 and vehicle 210. 

System 200 may optionally include one or more pseudolites 230. A 
"pseudolite" is a transmitting system located on or near the Earth's surface 
which emulates a GPS satellite. Because a pseudolite has a fixed, known 
position, it can greatly enhance the position estimates derived from GPS. For 
ease of discussion herein, only GPS satellites 102 will be referenced. It 
should be understood, however, that where position data from a satellite is 
required, pseudolite data may be substituted. 

Figure 3 shows a high-level block diagram of system 200 of the 
invention, including GPS satellites 102, vehicle 210, base station 220, and 
pseudolites 230. Vehicle 210 includes a vehicle positioning system (VPS) 310 
and a navigation system 320. 



Vehicle Positioning System (VPS) 310 

The task of guiding vehicle 210 aiong a prescribed path requires, 
among other things, an accurate estimate of the vehicle's current position 
relative to some reference point. Once the current position is known, vehicle 
310 can be commanded to proceed to its next destination. VPS 310 allows 
position estimates of vehicle 210 to be determined with extreme precision. 

VPS 310 includes a GPS processing system 312 and a motion 
positioning system (MPS) 314. GPS processing system 312 receives GPS 
data, i.e., navigation signals, from GPS satellites 102 and computes a first 
position estimate (FPE) for vehicle 210 therefrom. MPS 314 includes a 
vehicle odometer 316 and an inertial reference unit (IRU) 318 which track the 
position of the vehicle based on changes from an initial known position. MPS 
314 produces (the actual computations are done in VPS processing system 
324) a second position estimate for vehicle 210. The first position estimate 
and the second position estimate are independently derived. 

The first position estimate (from GPS) may be used as an independent 
indication of the position of vehicle 210. Similarly, the second position 
estimate (from MPS) may be used as an independent indication of the position 
of vehicle 210. In the preferred embodiment, however, the first and second 
position estimates are combined by a VPS processing system 324 (as discussed 
below) to produce a more accurate third or best position estimate. 

Navigation System 320 

Navigation system 320 receives the third position estimate from VPS 
314. Navigation system 320 uses this precise, third position estimate to 
accurately navigate vehicle 210. 

GPS Processing System 312 

GPS processing system 312 is the heart of system 200. With reference 
to Figure 4, GPS processing system 312 includes a receiver system 400 and 
a GPS processor 408. Receiver system 400 receives and decodes the 



-10- 

navigation signals from the satellites. GPS processor 408 then uses the 
information from receiver system 400 to compute the first position estimate. 

Receiver system 400 includes a GPS antenna 402, a preamplifier 404, 
and a GPS receiver 406. Antenna 402 is adapted to receive electromagnetic 
radiation in the radio portion of the spectrum. Preamplifier 404 amplifies a 
GPS navigation signal received by GPS antenna 402 from a selected GPS 
satellite. GPS receiver 406 is a multi-channel receiver which decodes the GPS 
navigation signals and produces a pseudorange and a satellite position for each 
selected satellite. GPS processor 408 uses the pseudoranges and satellite 
positions for a plurality of satellites to calculate the first position estimate for 
vehicle 210. 

In the preferred embodiment, antenna 402 and preamplifier 404 are 
integrated into a single unit. The combined antenna/preamplifier 402/404 and 
receiver 406 are available together under part number MX4200 from 
Magnavox Advanced Products and Systems Co., Torrence, California. GPS 
processor 408 includes an MC68020 microprocessor, available from Motorola, 
Inc., of Schaumburg, Illinois. 

Receiver 406 computes a pseudoranges for each satellite as follows. 
As described above, each signal transmitted by a GPS satellite is continuously 
encoded with the exact time at which the signal was transmitted. By noting 
the time at which the signal was received at receiver 406, a propagation time ' 
delay can be computed. This time delay when multiplied by the speed of 
propagation of the signal (2.9979245998 x 10 8 m/s) will yield the pseudorange 
from the transmitting satellite to the receiver. As discussed above, the range 
is called a "pseudonngt" because the receiver clock is not precisely 
synchronized to GPS time (causing a clock error) and because propagation 
through the different layers of the atmosphere changes the speed of the 
propagating signals (causing an atmospheric error). 

GPS receiver 406 may use an almanac to roughly determine the 
position of a satellite (e.g., for acquisition purposes). For a more precise 
determination of satellite position, the receiver decodes the GPS navigation 



signal and extracts ephemeris data therefrom. The ephemeris data indicates 
the precise position of the transmitting satellite. 

GPS processor 408 calculates the first position estimate using the 
pseudoranges and satellite positions from GPS receiver 406. This is described 
below with reference to Figure 5. 

Figure 5 shows a sample satellite constellation 202, having GPS 
satellites 102(a)-102(d), in view of vehicle 210. In Cartesian coordinates, with 
respect to the center of the Earth, satellite 102(a) is located at (x^y^z,); 
satellite 102(b) is located at (x 2 ,y 2 ,i 7 ); satellite 102(c) is located at (X3.y3.z3); 
satellite 102(d) is located at (X4.y4.z4); and vehicle 210 is located at a position 
(U x ,U y .U l ). 

The Cartesian (x.y.z) coordinates of each satellite 102 are determined 
by GPS receiver 406 using a satellite's ephemeris data. The pseudoranges 
(PSR,, PSR 2 , PSR 3 and PSR4) between vehicle 210 and each satellite are 
determined by GPS receiver 406 using transmission time delays. Given this 
information for at least four satellites, the location of vehicle 210 (i.e. 
receiver 406) may be determined using the following four distance equations: 

(x r Uf ♦ (y r Uf - (Z.-1// = (PSRrB^) 2 EQ- 1 

(x,-Cg 2 * <y 3 -Uf * (*,-£// = (W^W* EQ- 3 
(* 4 -ty 2 + <y 4 -uf * (z 4 -t// = («V«J m ' 4 

where: B clock = clock bias 
The "clock bias" is a zero order correction factor which attempts to 
compensate for the clock error discussed above. 

Note that there are four unknowns in these equations: U x , U y , U z , and 
B ciock- Note a,s0 mat 680,1 satellite produces an equation. Thus, we have four 
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satellites and four unknowns, allowing the equations to be solved for the clock 
bias (B clock ) and the position (U^Uy.U^ of vehicle 210. 

If die clock bias (B clock ) is eliminated, then only three variables remain 
in the equation such that only three satellites are necessary to solve for the 
position of vehicle 210. The clock bias can be eliminated if a high precision 
clock (e.g., an atomic clock) is used in receiver system 400. 

If the latitude (L) and longitude (X) of the vehicle are desired, they can 
be computed using the following equations: 



Latimde - cos" 



Longitude = tan" 1 —2 EQ. 6 



EQ.5 



Note that this latitude equation provides an approximate latitude. 
Determination of a more exact latitude requires that a complex iterative 
process be used. 

GPS Processing System 312 and Kalman Filtering 

From a user's perspective, GPS processing system 312 is the most 
important part of the autonomous vehicle system 200. GPS processing system 
312 is responsible for receiving the signals from each GPS satellite, for 
selecting the optimal satellites for processing, for determining the precise 
position of each selected satellite, for determining the pseudorange to each 
satellite, and ultimately for estimating the position of the receiver based on the 
satellite positions and the pseudoranges. All of this must be done using 
received data (of greatly attenuated amplitudes) which is most often heavily 
corrupted with noise (including noise produced by the atmosphere, the 
preamplifier and the receiver). GPS processing system 312 relies extensively 
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on Kalman Filtering to eliminate the noise from the GPS navigation signals. 
Kalman filtering is performed in GPS processor 408. 

The Kalman filter is a recursive least-squares algorithm which is 
normally implemented via software or firmware on a digital computer 
(processor 408). In the preferred embodiment, the Kalman filter assumes that 
the noisy signals are discrete rather than continuous in nature. Both the data 
and noise are modeled in vector form, and the data is processed recursively. 

A Kalman filter performs two functions. First, it extrapolates a data 
estimate from previous data. Second, it updates and refines the extrapolated 
data estimate based on current data. For example, if a vehicle position pj and 
velocity v x are known at time t lf then the filter (performing the extrapolation 
step) will use p, and v x to estimate a position pj at a time U. Thereafter 
(performing the update step), newly acquired data at time t 2 is used to refine 
the position estimate p 2 . Data which is fed to the Kalman filter to aid in either 
the extrapolation or the update/refinement steps is said to "constrain" the filter. 

Kalman filtering is well known in the art. For a more detailed 
discussion on Kalman filtering, see Brown, R. G. f "Kalman Filtering: A 
Guided Tour, " Iowa State University; and Kao, Min H. and Eller, Donald H., 
"Multiconfiguration Kalman Filter Design for High-Performance GPS 
Navigation/ IEEE Transactions on Automatic Control, Vol. AC-28, No. 3, 
March 1983, the relevant teachings of which are incorporated by reference. 

Conventionally, because the Kalman filter is a linear filter, the distance 
equations set forth above are not solved directly, but are first linearized. That 
is, the equations are differentiated and the derivative of each equation is solved 
in order to compute a change from a last known position. For example, a first 
position estimate at time ^ can be rapidly computed by GPS processor 410 by 
differentiating the navigation equations and solving for a change in position 
(AU x ,AU y ,AU 2 ) from a last known vehicle position (U Xf U^U^.! at t^. This 
greatly simplifies the solution of the distance equations. 

As an alternative to Kalman filtering, least squares estimation or best 
fit polynomial matching may be used. 



-14- 

Base Station 220 

GPS data from constellation 202 of GPS satellites 102 is also received 
by base station 220. Base station 220 comprises a host processing system 328. 
Host processing system 328 is similar to GPS processing system 312 of vehicle 
210 in that it contains a GPS receiver (e.g., a Magnavox model MX4818) for 
determining the position of the base station with respect to the center the 
Earth. The base station is used to make a "differential GPS system". 

In a differential GPS system, a GPS computed position of the base 
station is used in conjunction with the known position of the base station to 
compute biases. By producing a bias or correction factor for each 
pseudorange, the base station can quantify and correct errors present in the 
first position estimate. 

The base station can compute biases in a variety of ways. In the 
preferred embodiment, the GPS computed pseudorange from each satellite is 
compared to a computed distance (d) between the satellite and the known 
position of base station 220. The difference is a -differential bias" caused by 
atmospheric and other errors as discussed above. The base station computes 
a bias for each satellite used in the position computations. These biases, when 
communicated to the vehicle over communication channel 225, can be used to 
improve the accuracy of first position estimate. 

The distance (d) between a satellite at a position (x,y,z) and a base 
station at a position (B^By.Bz) is computed using the standard distance 
equation: 

(x-Bf * (y-Bf - (z-Bf =d 2 EQ. 7 

The position (x.y.z) of the satellite is computed from the satellite's ephemeris 
data. 

The differential GPS system assumes that vehicle 210 is located 
relatively close to base station 220, e.g., within 40 km, such that the 
atmospheric errors present at base station 220 are approximately the same as 
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the atmospheric errors present at vehicle 210. This allows the vehicle to 
correct, i.e., improve the accuracy of, the vehicle's first position estimate 
based on information generated at the base station. 

Motion Positioning System (MPS) 314 

As discussed above, MPS 314 includes a vehicle odometer 316 and an 
inertial reference unit (IRU) 318 which track the position of the vehicle based 
on changes from an initial known position. The vehicle odometer 316 
produces data on the distance travelled by vehicle 210. The IRU 318 
comprises laser gyroscope(s) 320 and accelerometer(s) 322 which can be used 
to produce position, velocity, roll, pitch and yaw data. MPS 314 provides the 
IRU data and the ooometer data to VPS processing system 324. An MPS 
inter-communications processor 326 controls the format of the MPS data 
which is provided to VPS processing system 324. From this data, VPS 
processing systems 324 produces a second position estimate for vehicle 210. 

VPS Processing System 324 

As mentioned above, the first position estimate (FPE) from GPS may 
be used as an independent indication of the position of vehicle 2 10. Similarly, 
the second position estimate (SPE) computed from MPS data may be used as 
an independent indication of the position of vehicle 210. In the preferred 
embodiment, however, the first and second position estimates are combined 
by VPS processing system 324 to produce a more accurate third or best 
position estimate (BPE). To accomplish this, VPS processing system relies on 
Kalman filtering and on weighted averaging to optimally combine the data 
from GPS processing system 312 with the data from MPS 314. This method 
for producing a BPE is illustrated in a flow chart 600 of Figure 6. 

At a step 602, an optimal constellation of satellites (designated "SV 
for H space vehicle'') SV r SV 4 is selected. While at least four satellites are 
required, a greater number may be used to improve the accuracy of the first 
position estimate. Steps 603-607 are concerned with producing a differential 
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bias for each satellite as discussed above. Steps 608*612 are concerned with 
using GPS data and the differential biases to compute an accurate first position 
estimate (FPE) and for combining the FPE with a second position estimate 
(SPE) from MPS 314 to produce a third or best position estimate (BPE). 

Computation of a differential bias at the base station proceeds as 
follows. At step 603, the ephemeris data and range data are received from 
each satellite. The pseudorange (PSR) to each satellite is determined at step 
604. Then, at step 605, the position of each satellite is computed using the 
ephemeris data and the GPS time. At steps 606, a range between each 
satellite and the base station is computed as discussed above using the known 
position of the base and the ephemeris indicated position of each satellite. At 
step 607 f the computed pseudorange for each satellite is compared to the 
computed range between the base station and the corresponding satellite. This 
comparison yields a "differential bias" for each satellite. The differential 
biases are transmitted to the vehicle for use in computing an accurate first 
position estimate. 

Computation of a best position estimate at the vehicle proceeds as 
follows. At step 608, the ephemeris data and range data are received from 
each satellite. The pseudotabes (PSR's) to each satellite are determined at 
step 609. Then, at step 610, the position of each satellite is computed using 
the ephemeris data and the GPS time. At step 611, an FPE is computed for* 
vehicle 210 using the pseudoianges from step 609, the satellite positions from 
step 610, and the differential biases from the base station (step 607). Finally, 
at step 612, the second position estimate from MPS 314 ami the first position 
estimate from step 611 are combined to produce a third or best position 
estimate (BPE) for vehicle 210. 

In the preferred embodiment, the FPE and the SPE are combined using 
a weighted combiner. Because the FPE is inherently more accurate, it is 
normally given more weight then the SPE. However, since both the FPE and 
the SPE are independently derived, either can be given full weight if the other 
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becomes corrupted. The weighting factors are assigned based on the estimated 
respective accuracies. 

Note that steps 603-607 are performed at base station 220, while steps 
608*612 are performed simultaneously at vehicle 210. If desired, the raw GPS 
data (pseudoranges and satellite positions) may be transmitted from base 
station 220 to vehicle 210. All computations may then be carried out at 
vehicle 210. 

While this method leads to a best position estimate, its accuracy is 
dependent on the integrity of the GPS data from GPS satellites 102. As 
discussed above, the GPS data may be purposely corrupted by the government 
using selective availability, or a satellite malfunction may produce erroneous 
GPS data. A differential system will substantially reduce the effects of these 
errors. However, it may not completely eliminate the errors. Further, a 
differential system is not always available. 

The present invention provides a system and method for accurately 
determining the position of a satellite. Generally, this is accomplished by 
predicting an average orbital path for each satellite based on past data. Once 
an orbital path is predicted, the position of a satellite may be quickly 
determined. This is illustrated in Figure 7. 

Figure 7 shows a flow chart 700 illustrating the steps of the present 
invention. At step 702, navigation signals are received from the constellation 
of GPS satellites. This data is then used at step 704 to predict an orbital path 
for each satellite in the constellation. Once the orbital parameters for the 
satellite have been predicted, the position of each satellite can be determined 
as a function of GPS time, without relying on satellite ephemeris data. This 
is illustrated at step 706. 

In a first embodiment, the position of a satellite is determined with 
indirect reliance on the ephemeris data from the constellation of satellites. In 
a second embodiment, the position of a satellite is determined without reliance 
on any satellite provided ephemeris data. 
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In the first embodiment of the invention, the orbital path of each 
satellite is predicted using a method 800 illustrated in Figure 8. At step 802, 
a BPE is computed for the vehicle at a time t lf where t is GPS time. At step 
804, the BPE for the vehicle is used to refine the pseudorange to the selected 
satellite (SV k ). That is, since the vehicle position (U lct U yt U z ) l and the satellite 
position (x,y,z) k j are accurately known at time t t , an accurate pseudorange 
( psR k,i) ma Y be determined from the following equation: 

Steps 802 and 804 are repeated, at step 806, for times t>, t 3 , t 4 , and t^. 
The vehicle may be in motion during this period, or it may be stationary. 

At step 808, a first mean or average position Pj = (^k^ic*^k)i *° r 
satellite SV k is computed using the data from times t lv t 2 , and t 3 and the 
following equation: 

for t = r^ 

This will yield three equations, which can be used to solve for the three 
unknowns (x" k , y k ,7 k ) 1 which make up the mean position of the satellite SV k : 

SfVj* * <£-tf y .i) 2 ♦ bt-Uj 2 = (PSR^) 2 
(XfUj ♦ (y^Uj 2 ♦ fc-iy* - (PSR^ 2 

At step 810, a second mean or average position P 2 = (x k , y^T^ for 
satellite SV k is computed using the times t 2f t 3 , and t^ At step 812, a third 
mean or average position P 3 = 0t k ,y k ,7 k ) 3 for satellite SV k is computed 
using the times t 3 , t 4 , and tj. The three average satellite positions P lt P 2 , and 
P 3 are then used to predict an orbital path of the satellite SV k at step 814. For 
example, the orbital parameters (cphemeris data) for satellite SV k may be 
predicted using a best fit curve method (i.e., a best fit elliptical orbit is found 
which includes the three data points). 
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Thrcc data points are the minimum which are necessary to determine 
the orbit of a satellite using a best fit curve method. Additional points may 
be used to improve the accuracy of the prediction. Further, alternate ways of 
predicting the orbital parameters of the satellite from the data points may be 
used. For example, Kalman filtering may be used to predict the orbit of the 
satellite from a plurality of data points. Additional ways of predicting the 
orbital parameters will be apparent to a those skilled in the art. 

Once the orbit of a satellite can be predicted, the position of the 
satellite at a next time ^ can be computed using GPS time. This is illustrated 
at step 816. The computed GPS position can be used as the true satellite ..... 
position. 

Steps 802-814 of flow chart 800 illustrate the initialization of the 
invention. Five time points (tp^) are used to predict the orbital parameters 
of a satellite. Once the orbit of the satellite has been predicted, the integrity 
of the ephemeris data from that satellite can be checked at each subsequent 
data point, if desired. Further, if the ephemeris data is monitored, it can be 
used to continuously refine the orbital parameters for a satellite. This is 
illustrated in flow chart 900 of Figure 9. 

At step 902, ephemeris data and pseudorange data are received from 
an SV at a time t^ At step 904, the GPS time and ephemeris data are used 
to compute a position of the SV. At step 906, the GPS time and the predicted 
orbital parameters are used to predict the position of the SV at t„. 

At step 908, the computed position of the SV from step 904 is 
compared to the predicted position of the SV from step 906. If the predicted 
position of the satellite is approximately equal to the GPS computed position, 
then the GPS data is assumed to be VALID or GOOD and the GPS ephemeris 
data is used to compute the BPE for the vehicle at step 910. Thereafter, if 
desired, the new position data may be used to refine the predicted orbital 
parameters for the satellite at steps 914-918. 

At step 914, the BPE is used to refine the pseudorange for the satellite. 
At step 916, a mean position for the satellite is computed using data from 
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times t^* i^x and t^. At step 918, the mean position of the satellite is used 
to refine the predicted orbital parameters for the satellite. The more data 
which is compiled for a satellite in this manner, the greater is the accuracy of 
the orbit prediction. 

If, at step 908, the GPS computed satellite position is not 
approximately equal to the predicted position of the satellite, then the GPS 
data is probably INVALID or BAD, and the predicted ephemeris data is used 
to compute the next vehicle position at step 920. 

The above discussion has focused on the method of the invention as it 
applies to a single GPS satellite. This method, however, is repeated for 
additional satellites as desired. For example, if a constellation of five satellites 
is used for the navigation of an autonomous vehicle, then the method may be 
used to monitor the integrity of the GPS data from all five satellites in the 
constellation. 

The embodiments of the invention heretofore described smooth out 
errors in satellite position as indicated by satellite ephemeris data. That is, 
ephemeris data is downloaded from a satellite. GPS time is then used to 
determine the position of the satellite. A drawback to this approach is that 
precise GPS time is required to compute an accurate satellite position. 

In addition, these embodiments of the invention rely on vehicle best 
position estimates to compute the orbit of a satellite. Best position estimates 
rely on ephemeris data from the constellation of GPS satellites. Thus, the 
embodiments are based on the assumption that the initial satellite tracking of 
steps 802-806 occurred in the absence of corruption by selective availability 
or, alternatively, that the character of the initial corruption was known. 

In the second embodiment of the invention, the average orbital path for 
a satellite is predicted without using the ephemeris data from the satellite. 
Rather, "local ephemeris data" is generated for the satellite. This embodiment 
is illustrated in a flow chart 1000 shown in Figure 10. 

In a step 1002, a GPS navigation signal is received from a satellite 
(SV) at a time t x . A pseudorange (PSR) to the satellite and a satellite velocity 
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is determined at step 1004. The satellite velocity can be determined by any 
number of known methods. For example, the velocity may be computed from 
phase shifts in the carrier wave of the navigation signal (using accumulated 
delta range (ADR) techniques). 

At step 1006, steps 1002 and 1004 are repeated for times tj, t 3 , t 4 , t^ 
The velocity (v) and pseudorange (PSR) for the satellite at times t lf t 2 and t 3 
are then used in conjunction with the known position of the base station 
(B x ,B y ,B z ) at step 1008 to compute a first estimated position (x,y,z) 3 of the 
satellite at time t 3 using the following equations: 

(x - Bf + (y - Bf + (z - Bf = (PSRJ 2 EQ- U 

(x - B x - vjLt^f + (y - B y - v^At^) 2 + m n 
(z-B„ - Vjlt^f - (PSRf 

(x - B z - vj*h* ' V Ar u>* + & " B y * v * At v * V Ar u* + 

EQ. 13 

where; v^, v^ 2 » = the x, y, and z components, ■ 
respectively, of velocity for the satellite at time t 2 . 

v xi» v yi» v zi " * c x » y» ^ z components, 
respectively, of velocity for the satellite at time t v 

At u « tj - t, 

At step 1010, a second estimated position (x,y,z) 4 of the satellite is 
computed at time t 4 using the pseudorange and velocity data for times t 2 , t 3 
and t 4 . At step 1012, a third estimated position (x,y,z) 5 of the satellite is 
computed at time ^ using the pseudorange and velocity data for times t 3 , t 4 
and t 5 . Steps 1010 and 1012 are performed identically to step 1008. The 
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estimated satellite positions for times t 3 , t 4 , and t 5 are then used to predict an 
orbital path for the satellite at step 1014. 

Once the orbital path of the satellite has been predicted, the data may 
be used in place of the satellite ephemeris data to accurately determine the 
position of the satellite. This is illustrated at step 1016 where the predicted 
orbital parameters are used to predict the position of the satellite at a next time 
Because this method computes a satellite position without relying on 
satellite ephemeris data, vehicle position estimates may be made free from the 
negative effects of selective availability. 

Steps 1002*1014 may be repeated to continuously refine the predicted 
orbital path of a satellite as illustrated in flow chart 900 of Figure 9. 

The method of the invention relies on the following assumptions: (1) 
each satellite is deployed in a fixed orbit; and (2) all biases, e.g., clock and 
atmospheric, can be initially corrected. Atmospheric biases are corrected 
using a differential GPS system. If a differential system is not used, then the 
initial position of vehicle 210 must be accurately known. Moreover, in the 
case of such an open-ended system, the vehicle cannot be run for long periods 
of time. That is, periodic initialization is required. 

Note that clock biases have been omitted from the equations set forth 
above to simplify discussion. If present (i.e., a precise clock is not used), 
then clock biases may be included in the equations of the embodiments sdt 
forth above. The result will be that an additional equation will be required to 
solve for the clock bias. 

Note also that the predicted orbital parameters derived using the 
invention are valid at most for one pass of the satellite across the sky. The 
next time the satellite comes into view, all parameters must be recomputed. 
As discussed above, the computed position of a satellite can also be 
used to check the integrity of the satellite ephemeris data. That is, ephemeris 
data from the satellite can be compared to the predicted data for consistency. 
If the predicted position is approximately equal to the ephemeris indicated 
position, then the GPS data for SV k is assumed to be VALID or GOOD. If, 
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however, the ephemeris indicated position is not approximately equal to the 
predicted position of satellite SV k , then the GPS data is probably INVALID 
or BAD. By "approximately equal to", it is meant equal to within a pre- 
determined tolerance range. 
5 Heretofore, preferred embodiments of the invention have been 

described. Persons skilled in the art, however, will recognize a variety of 
additional ways of practicing the invention. For example, with reference to 
steps 702 and 704 of Figure 7, a variety of methods may be used to accurately 
determine the position of a satellite. These include using four base stations (or 

10 vehicles having known positions) to precisely triangulate on the position of a 
satellite using data from a single time without relying on the ephemeris data 
broadcast by the satellite. It is possible that orbital parameters computed in 
this fashion could be accurately used for as long as several days. 

Note that the embodiments of the invention discussed above deal 

15 primarily with monitoring the integrity of the ephemeris data or replacing the 
ephemeris data with predicted orbital parameters. However, the pseudoiange 
data, i.e., the encoded transmission time of a signal, transmitted by a satellite 
may also be corrupt. Bad pseudorange data will be monitored and corrected 
or eliminated when a best position estimate is computed using the differential 

20 system (see flow chart 600). The integrity check of the pseudorange data can 
be done by the base station in step 609 or by the vehicle in step 610 (see 
Figure 6) where Kalman filtering will reject out of range data (i.e., a sudden 
step in position). Thus, the present invention provides a means for monitoring 
the integrity of both ephemeris data and pseudorange data broadcast by a GPS 

25 satellite. 
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1. A method for determining the position of a satellite 
in a satellite based navigation system using a receiver 

5 having a known position, the method comprising the steps 
of: 

receiving, from the satellite, a plurality of 
navigation signals at the receiver; 

determining a plurality of mean satellite positions 
10 from the navigation signals; 

computing orbital parameters for the satellite from 
the plurality of mean satellite positions; and _ 

predicting the position of the satellite at a time t n 
from the orbital parameters. 

15 

2. The method of claim 1, wherein each of the plurality 
of navigation signals is received at the receiver at a 
different time. 



20 3. The method of claim 2, wherein the step of computing 
comprises performing a best fit curve approximation. 

4. The method of claim l, wherein the step of determining 
mean satellite positions comprises the steps of 
triangulating to determine the position of the satellite 
using the pseudoranges and the known position of each 
receiver; and 

repeating the signal receiving and triangulating steps 
to determine a plurality of positions of the satellite. 

5. The method of claim 2, wherein: 

the navigation signals are received at three different 
times; 

satellite velocities and pseudoranges are calculated 
for each of the receiver navigation signals; and 

the orbital parameters are calculated using the 
calculated velocities and pseudoranges. 
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6. A method for determining the position of a satellite 
in a constellation of such satellites of a satellite based 
navigation system, the method comprising the steps of: 

determining a first receiver position at a time t, 
using the constellation of satellites; 

determining a second receiver position at a time 
using the constellation of satellites; 

determining a third receiver position at a time tj 
using the constellation of satellites; 

determining a fourth receiver position at a time t 4 
using the constellation of satellites; 

determining a fifth receiver position at a time- 
using the constellation of satellites; 

selecting one of the satellites from the 
constellation; 

computing a first mean satellite position for the 
selected satellite using data from times t 1f t^, and t 3 ; 

computing a second mean satellite position for the 
selected satellite sing data from times t^, tj, and t 4 ; 

computing a third mean satellite position for the 
selected satellite using data from times t 3 , t 4 , and t^; 

computing a set of orbital parameters for the selected 
satellite using the first r second, and third mean satellite 
positions; and 

predicting the position of the selected satellite at 
a time t n using the orbital parameters. 

7. The method of claim 5 or claim 6, further comprising 
the step of: 

comparing the predicted position of the selected 
satellite at time t n with a position indicated by ephemeris 
data of the selected satellite at time t n to monitor the 
integrity of satellite ephemeris data. 

8. The method of claim 6, wherein each step of 
determining a receiver position comprises the steps of: 
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receiving a first navigation signal from a first 
satellite; 

computing a first pseudorange and a first satellite 
position based on the first navigation signal; 

receiving a second navigation signal from a second 
satellite; 

computing a second pseudorange and a second satellite 
position based on the second navigation signal; 

receiving a third navigation signal from a third 
satellite; 

computing a third pseudorange and a third satellite 
position based on the third navigation signal; 

computing an estimated receiver position based on the 
pseudoranges and the satellite positions using a 
triangulation technique; 

refining the estimated receiver position based on bias 
data from a base station to produce a first refined 
receiver position; and 

refining the first refined receiver position using 
data from an inertial navigation system associated with the 
receiver to produce a second refined receiver position. 

9. The method of claim 8, wherein each the step of 
computing a mean satellite position comprises the steps of: 

computing a refined pseudorange for the selected 
satellite at a first time using the second refined receiver 
position and a position of the selected satellite indicated 
by ephemeris data; 

repeating the step of computing a refined pseudorange 
for a second time; 

repeating the step of computing a refined pseudorange 
for a third time; and 

computing a mean satellite position for the selected 
satellite for the first, second and third times from the 
refined pseudoranges and the second refined receiver 
positions . 
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10. An apparatus for use with a vehicle for determining 
the position of the vehicle relative to the center of the 
Earth using navigation signals from a Global Positioning 
System (GPS) which includes a plurality of satellites 
orbiting the Earth, the apparatus comprising: 

first means, having a known position, for receiving 
the navigation signals from the plurality of satellites and 
for computing a first pseudorange and a velocity for each 
satellite at a plurality of discrete time intervals; 

second means for receiving the first pseudoranges and 
velocities for the plurality of discrete time intervals for 
each satellite and for computing orbital parameters Tor 
each satellite therefrom; "and 

third means, for computing a position of each 
satellite from the orbital parameters. 

11. The apparatus of claim 10, wherein the first means 
comprises a first GPS receiver and a first GPS processor 
located at a base station. 

12. The apparatus of claim 11, wherein the second means 
comprises a second GPS processor mounted on a vehicle. 

13. The apparatus of claim 12, wherein the second means 
comprises a second GPS receiver coupled to the second GPS 
processor, the second GPS receiver adapted to receive the 
navigation signals from the plurality of satellites, to 
compute a second pseudorange for each satellite, and to 
provide the second pseudoranges to the second GPS 
processor, the second GPS processor adapted to receive the 
second pseudoranges and the orbital parameters and to 
compute an estimated position of the vehicle therefrom. 

14. An apparatus for use with a vehicle for determining 
the position of the vehicle relative to the center of the 
Earth using navigation signals from a Global Positioning 
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System (GPS) which includes a plurality of satellites 
orbiting the Earth, the apparatus comprising: 

first means, mounted on the vehicle, for receiving the 
navigation signals from the plurality of satellites and for 
computing the position of the first means based on 
ephemeris data and pseudoranges computed from the 
navigation signals; and 

second means for monitoring the integrity of the 
ephemeris data and for determining if any of the ephemeris 
data is corrupt. 

15. The apparatus of claim 14, further comprising:- - 
third means for compensating for any corrupt ephemeris 

data when computing the position of the first means. 

16. A method substantially as described with reference to 
the accompanying drawings. 



17. An apparatus substantially as described with reference 
to the accompanying drawings. 
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